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(57) Abstract: A legged mobile robot, 
particularly, a biped robot, wherein a dynamic 
model showing the relation between the motion 
of an upper body and a leg part and a floor 
reaction is provided, the parameters of gait 
patterns including the parameters determining 
the routes of the leg part are determined 
temporarily, the parameters of cyclic gait patterns 
followed by the gait patterns arc estimated, the 
parameters of the gait patterns are corrected 
so that the routes of the upper body determined 
based on the dynamic model and the parameters 
of the gait patterns are converged to the routes 
of the upper body determined by the parameters 
of the cyclic gait patterns, arid the instantaneous 
values of the gait parameters are determined 
based on the corrected parameters, whereby 
the gait patterns such as any step, turning angle, 
and walking frequency can be generated by 
generating freely and in real time the gait patterns 
including the floor reaction while meeting the 
requirements for dynamic equilibrium, the gait 
patterns allowing the continuous displacement 
and speed of each portion of the robot and a 
high allowance of stability can be generated 
in the boundaries between the generated gait 
patterns, and the gait patterns can be generated 
by predicting the future behavior of the robot so 
that an inconvenience such as an uncontrollable 
attitude Is not produced. 
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£*: s «fc*7fc«5$l 5&JtiR-r*dtK:J;!K f&f5:J£#q Ck] 

A^)ZMPpend[i](i=0, 1. 2. . . . k : l) *XJr$~Z> c fcM\ 

k-i 

U0= £ (exp(- a> Oi At)*ZMPpendII]) 

is=0 " • • • * 1 6 

EP£. A*ZMPpend[i](i=0.1,2..'.,k-l) B\ 6KJ;-?T> «DJB^^^ 

SP8H(=^t* J:-5ICx ZMPpend[i]^^eimfa)-r-^?). ZMPpend' [i] 
tfHISlfCD^Iln A t tz \fm<b-&1zmm (i- dAOT^S t U A^jMZMPpeb 
d[i]£&&^loUC&mUfct>©£UO, A^MZMPpend* [il £OT^Vt/X<::^l 

UC =UO*exp(-ii<o 0 At) 

• " ' • • -gel 7 

t 

BPfe. f^— ja^OA^^Hii A tfcital^^TA^-rSfc, *©A*do 
T3S£-f £SS&j££-tes -expC-niDO AtM£fc:#£o 

fc £ CD 3g@tf£# (c o V S o 



IS # M & 
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#*&nsZMPA:*J«u S^ZMPfcmtotalM **Ufet>©t^ JHZMPfr 
&*©*?. g^ZMPKmtotal/rab «-3£ttrt:k©^ ^li^tiiOS^T** 

O 

tc^P^I (tK^®±) &T©fiiirT&> mmo&BOiztb. 1&tg 

mftM^cDZM? (ZMPpend ) ^bVxmi omzzsrr&5tmti&&&%. 
•TSo EOit*. mn CWm) #period[i] *C^©K^©t3)Slffi^ZMP[i}*efe-5 
t-ric C©ZMP(c<}:-,T^-rS5l®:^^J6S/iJ6©MStT;U=fU>< 

.mtm^T'Mzm&m^zMPAJjtLT, x=f<.o^wMmm ten © 

t ©/^Ux©^:t$»cSit:b/i4©*HCf(t).T) t-T-So 

T/At-1 

H(f(t),T)= £ • (kAt)exp(-a>kAt) 

• ■ 8 

tozmftzw^xry^mieb? y^mi&bizftm-cizzo -ten?, ^-rx^^- 

^©^i:^>^©^{rSt-r5H(f(t).T) *BlTfcifi*<<&#«rc#«>*C:|S 
H(l,T)=<l-exp(- an)) / (l-exp(- o> At)) 

• •'• ftl 9 

itUiK (MI026) 
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x=f(t)=t©7V^B©H(fCt),T) £H(t.T)iga5&irsfc. &ft2QiZ*k 
H(t,T)/T=(At/r*exp(- co A.t)H(l,T)-exp(- cot)) / (l-exp(- co At)) 

te> Hgcf ZlEMlkVTfr^ HCfCO.p*^- ^A<b-rnii^v>o HSk Jb&M 
-CfeFCf(O.T) *f-^fl5tT^m\. 

t©«:£g^ZMP^Vl/x©:fc&&fcmirL/c%© c^Wi^t)'^ 
$-f v mm i (i=0. 1. -^©gteiS^ZMP©!^^ KIS i ©SJffiiWfcA 

^Vl/xilfliSS 2 1 izm-t J: -5 left £ 0 

• inf[i]=H(l, period[q)*ZMP[i]+H(t, pedodpD / period|l]*(ZMP[i+l] -ZMP[i]) 

• • '^(21 

&t/vc. EfSperiodti] Ci=0. 1 m)Ofl4i?ZMPO^i^ WM0\z 

Xi)ii*i.Z>'<A'*-v%>~?x^ *o^HMB3&<*J*WA t©/-*;i/*©:*:'#£inf [i 
] ciJUrr*.. 1£!»3^£ % ^*&srmm:$2 2©j;?Kim£tt£o 

i-l 

inf '[i] = infp] *exp(- CO 0( £ periodpc])) 

k= ° • • - t22 



WO 02/40224 PCT/JP01/10026 

29 



W= £ inf '[i] 

• • -g£2 3 

i 

W*(exp(-a>OAt)-l) 

• • • gt2 4 

m 

W*(exp(- CO 0 At)-l)*exp(co 0( £ periodp])) 

i=0 

• • • tt*2 5 

£t Jb©#i|g £ t> . *rfttt©ftB>:» Z M P <£ ~> S 
# *«f«f tt k:* 26 £ c i # 3 o 

#©f££MNc£a63#vT?&.5o . 
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01 2^(*> *©^g£fjSgJ3 1 0 0 O^tl^ 7 d - • f t - h ( 
0 PUfttr. 

S l 8 C£trfcgtiiHtf t £ o Kt»fflWbU Jkf "CS 2 2 &SI*fM&£ 

&ir 0 z\tit>{±-ffimvtzmmzmm-tzfr, *^uwxyi>a-^ttt 

IB^bT:&V'>T&&< % fc-SWi^a^XT-.* y ? 4 4#£f©8l8£^fgj^£©Jf 

o (bp^. A-®&®t&imffl&wwi&mfr$&¥*mzmMz j &tc£^ 
zt£\,^5izm.w-*7k^£^®&istt &EJ£:#wiMi^t 

£ -fr * * N f-c £ * J: 3 K J£¥£tfci::®g^ £ £ t@$k $ -fr/c £ £ ©ft* 
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^<fc5Kjfc£-r*o <&«i©&£tr&/h©i&£ftj& (v^#££f#0ft^) ©* 

6 0 8 l#&«JCEJfi) ) o fcrtfU 4-H*«©ZMP«lit^ *-*tts 

ars-r«5t> «imisF^«F«:> i*8©«5fc-c©3M& mmzmmv® 
ma**©*** k& v % 3mtf&*&%t z> a tf izm v * £ n s © *e> &ga<jKH£ t 

So 
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o 

01«Eia*«F*Jj:CF*2jfel@I*«F©*ffJ9Jlittx fcl»»iJB ( 

.» itiia*«*?j:cF*2«iig^«©ZMPttj8:^y~^fe^ sfifM«^A< 
& 1 «rBM(D^s«Nr«frr« t#©®JB-L#ft^£<fcM«a<, uriBsejtbfc 

&«-bftrafj&{fcg&K©€ X 0 , V 0 fc-3S-r* 0 CI ©MX 0 , V 0 * rj£# 
&!»&©&ffl±#ft^j&tttti£&J fc^o C©W«*Hi::«-r^ $141 
OA^CttS* te'«U X0^(xO, yo) t^tcttU V0i:oi>Tli 
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tera#«*2Sfc»l)fil/^LT«K »3T&SIJ&<OTrLtt^lEtK SUSSEX 
&©imfc#ft££4fcfM£«:> #CX0. VOfcttSo *Mf©if«f£## 
SE3ft£ e C©i*©35ftfifcfl\ BP^ S XO + V0/o)0 r&ftttQMFa&fli 

KK1 5 0tt, *1 207Q- • h©S 2 8 ©£jmaM©fDi§&ito 

* 

q[k] =exp( 0) Ok A t)*Q[0] 

k-1 

•+exp(G>OkAt)*(-exp(o0OAt)-l) £ exp(- CO 0 A t)*MtotaVmb*ZMPtotal[i]) 

i=0 
k-1 

-e^C0OkAt)*(-exp((i>OAt)-l) £ exp(-iC0 0 At)*mfbet/mb*ZMPfeet[f|) 

i-0 

- - • 1*2 6 
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->#fffttirefc£©T, Sm©frft®tfcZMPpend KJc^TSS&^i&iiSgftJjS 
&5£l 9, 2 0. 2 1, 2 2, 2 3, 2 5 ir^fT^^ >j XA^ffl 
t>T«?#rttfc#a&5 0 cn^Wzmptotalt-TSo (X Y^t^^^cd'C, Wzmpt 

»*4«U S6{cZMPfeetCi](i=0.1.-.k) fta*l, 2*N&j£a&. en* 

±mom< LT«J6^nfc«^Wfeetir-rSo (XY^lRl^*»5CD-e. Wfeet 
l*2&5c<2 ) 
RfciiK K«2 7^, 

qJk]=exp(coOkAt) * qJO]+ Wzmptotal+ Wfeet 

• • -*2 7 

ayi:5e#te@»*38ikjR^^q' Ck] t-rst. *©»5t2 8*»tjai/tti**i 

qP3=q , |k] 

• • >R2 8 
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qPc]=Mq'[k:]+B 

2 8 k&A 2 9 J; 0 „ &©&5$ 3 0 £#S 0 
q|W=.Mql3D]+B 

• • • &3 0 

»^3 0 i&5c$2 7 cfct>, &©£fcE$3 1 £f§* 0 
Mq[0]+ B = exp(o) OkAt) * q[0] -f Wzmptotal + Wfeet 

-S3 1 

v h U ? ?XA©i£ff?9£inv(A) fcf3*£-r<&£, ^3 1 ^£&5$3 2## 
qC0]= inv(M- exp(<DOkAt)I)(Wzmptotal+ Wfeet-B) 

• - ^82 

*e>. &v>-es i o 2»rii#, ^2 e o#m&zm&m^xmB.jitz&^Tm&i 

"rS»fg3£«CJj£#£#a6. #C^T?S 1 0 4 Kit*. 2£ffl^T5£1£^lltD 
833g«:Jj£#q CO] So ^SelalSJW^^q CO] l±> 

&c^*Cs s i o 8(ca* % &imm*Dm¥&Wcffc&<i co] *4-s#fc*©3s:»iw 
commits 4-a*»©*»5B»*«»3&<q" k-sh-sj:^ ±e«»*u 
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P&mm (MjEfifc Splitting) £fi0x.5c:<bt;:J:*K 2MP*0jEf «o & 
3E&ftfcZMP£3fea&TB^ZMPi:l>-5o dtt£<DK$£S& 1 6@i:^t„ 

WHCSWftK, B&ZMP (ZMPtotal) =<EBg?ZMP + ZMPteIEg. t 
fcSJc^K:, eSZMP/N'^y-^^iEt-«o 

o B^ZMP^N-^-Vfc^oT^t-S^^gtfilS^Wzmptotaltt. BUZMP 
Wzmptotal^Wzmptmp+a* Wtrim 

* • -££8 8 

CCT^ WzmptmpfcU A-m&&<Dfc%mZMP'<?->\z£-3X&$L-fZ>f&m 
m&fc&T'&Za Wtrimte. a = 1 fc bfc^© Z M P f Et C J; T?l£t 5 

5£3 4£#£ 0 

q"= exp(oaOkAt) * qJPJ+ Wzmptmp + a* Wtxim+ Wfeet 

• • • 3 4 

a= (q n - exp(a>0kAt) * q(D] - Wzmptmp- Wfeet) /Wtrim 



■StS 5 
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2@7o- . bot&wizm&t^ m*~css o\zm&, 3-m&&& 

^■T5i^{g|gScfifeOTzmptBip^J6, &WtfS 2 0 2 Kii^ a = 1 
Z M P {^JEMf' J: ,T»fet * &«8&J$#Wtr im£#a6* 0 

Wfeet£Sci&. &H*CS 2 0 6 4-EI^<DlS3»35l«t5S5^ q [ 0 ] 

a £#ae>£ 0 fcfrvcs 2 0 8 liriBbfcJ: -5 i:I^ZMP©a«7 y 

KTKWt*^ S 3 0 0(C*?t>*C. BMW tic*? 

#*i*ZMP*#tfK S 3 0 2tcii* s 4-®#s*'<5/->*l6tc N If*! t tc 

s 3 o eicg*^ &Ai*j;cnbc2€m<,*T^ mt£j:cF*n 

&flr©HMWfcBS5»fr&* B*«fftlC*?W-««ZMP (ZMPfeet ) 

o 

&l^S3 0 8fC*&* B«8tfflV^ ^Jg^ZMP(ZMPpend) *JWBb 
>S31 OlZift^ tt5$4*»WC^ «AJS^ZMP*N6«acjg^*3Plfeflt** 
Wt«. fc^*CSS 1 2 (Col*, «A*-?*VffilS^&i:«:©*3Fttfl|**)e-r 
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&^-cs 3 1 4 \zm*. w®Afr%\z<®Mw- 10-86O8 o#&$rei£& 

^S^SII 0 OKfcVvC, JifBL;teJ:5KB^^#&S&$ft£o 
nfcBfI^&0#^<7*-*<Z>* % B«-h#<fcg£g (fto!) tt, amy h& 

C^Eftli^ (MSP 2 2 R, L) K#IS£ft, B«#JE¥J£E:& 
<kCJ f B^=&S¥^S*55»<^§nT^=iV^-f T>X®(^^1 0 4K3I 

» 

<f;H 0 21*. B#.tf*&g££ O&t) fc®«tOtft£fffc&IEB^& 3 ^S 
^A*$n5fc> **l££-?fSJ&-r«& 1 2<SCDKSi (I0RCD4 

& <DM®mt&:m& cm «-»muTiE&=i>ha-5 i o sicaiSo 

1 0 8 1*. hM^T^b 1 0 2-vmtti&tltcM®%ZtiLt&& m 

) ^riMUCtLTo^C-y MCD1 2 <@<Z>KIt&CDg&£-iI^§il$|-r<So 
i^ta^fM «c^CfcHcE*^«-mmE*TOtiiSSl 10 (6*Stfj-b> 

•9-3 4) remans, ^m<iJ±i9Sb/cig^-3>y5-f T>^g>^^ 

Stfl 0 4 Kit M iz&ttcm&m&mme errx. tferryli 
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tf^ d©&flJJ©Hi W&&3iim 1 0 OKfcttSatf* h©*fcg£tfU::fcO> 
MAftftizmmistzftMspi 0 - 2 7 7 9 6 9^&®ft^i::f£jm::fa«£3ftT^ 

©"C> X&mAfrftKftmW- 1 0 - 8 6 0 8 l^Kfc^TSI&bfc&ai©JbtaU 

bp*., sen Bm\t±&f$m&<z>Ym-%fo ©tt**^*-f a • * 

£ fc s * n iz jfc -» T2Mr£tft ©Ktffc t> U TA/$<4 A ic£(ft-e 1 3 £ -5 K# & © 

o 

ICft*.* «*tfU^¥4 - 1 5 0 6 8#&f8-C£llgSft£ 1 

f£2 O0t*> C©£&©£-2©$jfc©Jgtt(;:ffi&jN^&f&a4*9 h©#*g£j£ 
SttOttflP©— JfU ©HJI5©^JIS©£ 1 6 BrcaHtt*r<5* £1?S£I§I$* 
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2G>mm<Dwmzh->T\u &«£f scpu miomnmms 0) oib^^ 
b 2 ©^©ratSK^sge©!^^-*-* $ 1 o&mommom 1 2 

ttfi&t (xo. vo) *««fc»f ±&&mmmii, jbftfts^<Dtt«taR 

5o X. Y#fc£|i3l${c!^Tr3i:&te> ffiftSn^Xttt, Y&g. X^S. 
Y^ffi0 4^5c(Ctt$„ 
Rlr^-CS 4 0 2£gTS 4 0 4 Cljg#. l&r&^T^ (312 8 BU^lyfe* 3 
^^CltjfttttSeUfcffH^tt*^*) £ffi^T (XO. YO) £-Jb&© 

fifleftfcttx BPZMPfcB«STO@£S£tB^±ffrS5f*£*&. (XO. 

Jb#«ia*fertw*. $1 osmosis kmrc* «ut&Att»«&mt i o o 

&InT?S 4 0 6 Kit*. &j£Lfc££©&^±^t^K£&£?© \&<t>%W 

mmmm cm \ 4S©x' - . y* ■ mmjhtmm) fr&Efcttfcsmu -e© 

fi£ (Xe, Ve) ttSo 

&^TS 4 0 8Ki§*. @^©*H<. (XO, VO) t (Xe, Ve) ©H ( 
errx.erry ) £gffi-#-£o WtE>. MUDM-Cli (XO, VO) t (Xe, V 
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e) ft-'&lsTWMtfttt'tz&te^Ckfrb. m%®m (errx.erry ) #0 bft 

k> mm&wcf&ft (xo+v o/wo) (xo-vo/ojo) ^ 

S4 1 OXWfeStiZb&teS 4 1 2K$i#, (X0, VO) ©ftSffifctttt© 
&SBtt«tt (XO+AXO, VO) , (XO, VO+AVO) *H?tL 

tzm (Xe+AXe 1. Ve+AVel), (Xe+AXe2, Ve+AVe2 

) &##>£o 

^"CS4 1 Hzm&, (XO, VO) ^J:^ON-i£(DtDSHS[<ilM^^* 

»m±#&m.xmkffizvtim&m^ ikgotnmmmm <xo, vo> 

S4 1 O-C^^tl-SKRtHiJbaLfc^S^glOjSt- t^tc. #5£&*iSt;§c 

\m*)ML*-zf cs 4 o 2) zmiTs 4 1 Bizm^ &im®®mE&a&& 
q co] *-0^oss:*>€)*J6So #i^-es4 1 8ic*i* % miomm^mmom 
1 5 ho s .i o e kmMtmw&ftoo 

ommfriztt lx t> M&K+^ttif KTSffi-r & - t so-c. s& 1 on 
efc^-e&i 2@ti^fii©7a- . htcfev>Ts 3 o izm*> -s-mtfr®® 

HT§Ji»t5^ S 5 0 0^-iSTS 5 0 2Kig# > <KiglZMP^ - > bt 

tjcioT^iii^^-coi^g^s (xe, ve) zzizi&mm 
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&j£#q [0] &El^<D3t£flHvrJfca6*o 

^fcgf-ITf Sd£KJ:oT. 4-ll#&&ig}-CcDJ:<*te|gi£g (Xe, Ve) £ 

^ts s i o\zm^ /<5y-^eKr*Bfo^&$», s 5 1 2 Kit 

liit)St^-y (S 5 0 0) &m\fXS 5 1 4Kai#. Si&tfjK^&tT/fciRB - 

S&o^SWIi^ &afcf t?fes q " k % S5£<c&si>fcUt#--IScl<TV^«i: ti- 
nt^ <5>*j:v>o 

© M /< v * - * cd * © a |R z m p ^ * - y * & iE-T £ £ 5 1 c b fco 
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CiRlfc (Hub U &g®fe®m®&%WMX'&^A-emir$hmiz&& 

*»Ktt, ^tt@#»«©Jb^Sifift©«ffltt««2:PI4ft(c«5&^i(» 
vo) voMtftttiratfr:/ (jubevHi^x) £*a6T&;£©^*fi£fc3£ 
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(fcstMi i ti£omm*7 s Ji,%%i,sx$>&^£ taws 

LXikfeZtizamZMPte. ffi3tLfc5£#lllll^©ZMP (-(KB^ZMP) 
b-mi-Z 0 tZZX, ^ttS0^©ZMP <<ESglZMP) &£* 

* <D& £<D 1 #fcT?fe.rc3Et«g-** § J; $ fcgjfcjfrtife tt/dg<£. £ 

2EKSSft&*S/ca&i;:BHZMPmm&:*;t <*nc?* £-r&g#£b. 5Sf3&fe« 

ft -5 *T?& £ 5 3M&lcft £^ < i£ < /.c * J: r> »=R£-r ZMX tb 3 
±&BlMfe%m®&&<b®%.¥m^ TOD fr£4) STic^c 4) 

£&<t. ^^{cfej^^n^-e&^^^t^ssiEi^o-rnii. -list 
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con, zMP««Eft*<*iiirr*. bps, fcjfcM&wrFrso 

» 2 2 sii. *©g s ©«©»»*=# *«©»fls©-ai*33**\ m 1 ©#S 
MratfB0©#i 3Hcis«-r* % &i&Mm&&0momi£m&7Fir$iwm'v&z 
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m 1 ®mfc®&&frt>% 3 ®mm®Mm*±fc®t® < ^ < t *,±.w 2 it 

«*feW3^«tta#» M©»8£jft&ff (MMffil 0 0) KfcV^ 

< it>flrlBJi#fcl«©31®Ffc, *K^3. AOJMtWtcttZMP t©H«**-r 

ffitR^ ft^*«£*MEi(** ^BMFJIIB. ftBUHfrJUBtt 2. S22) 
KCSb. ttems©4ttB <lfllSWS«Fi»«Ut) fcfirfBJ£K:*J©Jf&t (Btfcfe 
*S»*<OjSft« (IHZMPIkjt) ) ^ttw^-^m< fcfc-g-t? 
> 4-®^«o><5y«-^*«tfejet*-64-©^*-'<5y-^«ftje#«: (S2 4) 

©unB^y-^aje Tr*jiiB»**'<5/-^a«^« (S2 6) 

*©^<5 (S 3 0, S 2 0 0j&>€> 

S2 o 8) . *?j:a : ^< tt>fjK«§nfef(rB^ia^©^7y~^(rs^ 

V^TWia4-[sI#^©Wfi^^^-§^I5I^iil^^^S (S 2 0, S 3 0 

©SUSP (WJ 2«tt&fcJfl&C$ftoiKy h 1 ©£Mg&fiS^ffi 

01 0 0) icfct^T. t*»1iffc±ft:fcW»©attt N 0fcE:*J (ftttttKti 

zmp) totemzm-rmn^TJi' (msmtsz&mGWuzm?) > 

fcs* (S22) uusu* firsnrasoiftst (a^js^s^mit) tra^s: 
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cs 2 4) „ t*,frfa®«icE6b. i$tm*®&%iztii< mmto&® 
j»» (S26)> tiria^^w^oiifia/^y-^^-dt., uriajSJSW^ 

**mff»f^Hfeft&It (S28, S 1 0 0*6S 1 0 8K firf34-|sl^cD 

JBW*±-5«c. lWB4-H#*©'<5*-i\ i: t> fitful- tiBiSZMP©^* 
-^^IE'r*4-IaI^^5^-^^iE#K (S30. S 2 0 0^6S 2 0 8) 

£7^ #fc< tfcJifl:2 4 1WB±fclz«fc3ft**tt*, A^SfrttCtt 
2*©M3 (MRU >?) 2*ffijLfeN3$»a#9 h 1 ©£&&j&gg (M 

T-$>STOS*. iOMtttoKliiUZMP (ZMPfeet)$-ltria-h<*© 
*»Kttfr*^{c#H$-r*W»R*JHfJ^|H: (PZMP#Hlg2 0 0, S 2 0, 
S 3 0 6) „ 4>tt< tfeWEIWJ*njfelWIJKAfcIW*RA, J:$JM*ft«H=li 

^©3SCAtt« (Zlffpen^^irW^SWiCJiH^^^Xjftttmaj^a (S 2 0, 
S 3 0 8) „ ^ft< fcfet»»«*nfc«l^*f*©5t^tt«i;»^^TW 

ifcgxb) £*ffi^««ic»*7 s A^*fliJi&R (S 2 0. S8 10)>^< 
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aiR^lsCffl^ (PZMP»HiS2 0 0, S 2 0, 8 8 0 6) t s < fcfclif 
BiTHi*tlfcJHiaRAtilll*R* (BESZMP) t^fe, 4>fc< fcfcWBJitt 
©»A^W|S»*iasB"r*«a[«^ { e7 s ;l'<03tjft<ft* («A»ZMP (ZMPpen 
<0> ^ffl^^aftaw^^^SjftttBIICffl^R (S20, S 8 0 8) ^ 
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